package edu.wpi.first.wpilibj.templates.subsystems;

import edu.wpi.first.wpilibj.command.Subsystem;
import edu.wpi.first.wpilibj.*;
import edu.wpi.first.wpilibj.livewindow.LiveWindow;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj.templates.RobotMap;

/**
 *
 * @author Super NURDs
 */

public class Climber extends Subsystem {
    // Put methods for controlling this subsystem
    // here. Call these from Commands.

    Solenoid deployClimberSolenoid;
    Solenoid retractClimberSolenoid;
    
    public String climberPosition = "";
    public boolean climberDeployed;
        
    public Climber(){
        super("Climber");        
        try {
            deployClimberSolenoid = new Solenoid(RobotMap.CLIMBER_DEPLOY_SOLENOID);
            retractClimberSolenoid = new Solenoid(RobotMap.CLIMBER_RETRACT_SOLENOID);
        }
        catch (Exception e){
            e.printStackTrace();
        }
    }
    public void initDefaultCommand() {
        
    }    
    
    public void deployClimber() {
        deployClimberSolenoid.set(true);
        retractClimberSolenoid.set(false);
        climberDeployed = true;
    }
    
    public void retractClimber() {
        retractClimberSolenoid.set(true);
        deployClimberSolenoid.set(false);
        climberDeployed = false;
    }
    
    public boolean isClimberDeployed() {
        return climberDeployed;
    }
 }